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(54) AUTOMATIC FOLLOW-UP TRAVELING SYSTEM 

(57)Abstract: 

PROBLEM TO BE SOLVED: To realize serial line 
traveling with high traveling follow-up orbit precision for 
a leading vehicle. 

SOLUTION: The traveling orbit (X. Y, and 9) of a leading 
vehicle 101 driven by a manned operation is transmitted 
to following vehicles 102 and 103 driven by unmanned 
operations. The following vehicle 102 calculates the 
position and azimuth deviation amounts of the following 
vehicle 102 from the orbit information on the leading 
vehicle 101 and the position and azimuth information on 
the leading vehicle 101 from a laser radar 50, and 
corrects the location of the following vehicle 102 itself. 
The following vehicle 103 calculates the position and 
azimuth deviation amounts of the following vehicle 103 
from the orbit information on the leading vehicle 101 and 
the following vehicle 102 and the position and azimuth 
information on the following vehicle 102 from the laser 
radar 50, and corrects the location of the following 
vehicle 103 itself. Thus, the coordinate systems of the 
following vehicles 102 and 103 can be exactly matched with the coordinate system of the 
leading vehicle 101, and the manipulated variables of the following vehicles 102 and 103 are 
calculated based on each corrected location and the target location in the traveling orbit of the 
leading vehicle 101 so that automatic operations can be realized. 
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controlled variable (the amount of accelerator control, the amount of brake control, the amount 
of steering control) is generated (Step S29). 

[01 18]The motor 44 drives in the amount of accelerator control which constitutes this addition 
controlled variable being inputted into driving-force-control ECU42, The brake actuator 86 
drives in the amount of brake control being inputted into braking-force-control ECU84, and the 
steering actuator 90 drives in the amount of steering control being inputted into steering control 
ECU88. Thereby, automatic steering of the accelerator of the succeeding vehicles 102 and 103, 
a brake, and the steering is carried out, respectively (Step S30). 

[01 19]Subsequently, the succeeding vehicles 102 and 103 perform failure diagnosis (for example, 
failure diagnosis about the motor 44, the brake actuator 86, and the steering actuator 90) of a 
self-vehicle, respectively, and hold it as a code (Step S31). 

[0120]Next, the succeeding vehicles 102 and 103 detect the remaining capacity of the battery 
40, and hold it as a numerical value of 0 to 100% of inside (Step S32). The remaining capacity of 
the battery 40 can be calculated by making into percentage the value which deducted the value 
which integrated strength of discharge current from the amount of full charges, for example. 
[0121]The succeedi ng vehicles 102 and 103 perform the flattery deviation judging of being less 
than the amount of gaps predetermined whether they are the distance between two cars (delta 
X) with the preceded vehicle measured with the laser radar 50, and less than the distance 
between two cars respectively predetermined in the amount of gaps of the cross direction 
(delta Y), and hold the result (Step S33). 

[0122]Subsequently, each succeeding vehicles 102 and 103 transmit these failure codes, battery 
remaining capacity, and a flattery delay decision result to the leading car 101 (Step S34). 
[0123]The succeeding vehicle 102 transmits a its present location, a direction, and a correction 
amount to the succeeding vehicle 103 (Step S35). Then, the processing from Step S21 is 
repeated. 

[0124]On the other hand, the leading car 101 receives the state information of each succeeding 
vehicles 102 and 103 transmitted at Step S34 (Step S7). 

[0125]The leading car 101 updates the screen display information of the display 82 based on this 
state information (Step S8). 

[U 126] Drawing iy shows the example which formed the possible status display part 142 of ~ 
displaying the state of four sets of the succeeding vehicles 1, 2, 3, and 4 as an example in 
Screen 140 of the display 82 for the navigation devices of the leading car 101. In this status 
display part 142, O seal of the succeeding vehicle 1, 2, 3, and 4 (1, 2, 3, and 4 are numbers of 
succeeding vehicle) bottom is classified by color, and it is shown that that succeeding vehicle is 
carrying out the flattery run normally in being green, and, in the yellow case, it shows the case 
where the flattery delay more than predetermined, etc. occur in that succeeding vehicle. When 
flattery delay etc. occur, by the loudspeaker 81, please flattery-delay-generate in "succeeding 

vehicle and slow down to it. Please slow down. Warning with sounds sur.h as " is mad* 

[0127]In a red case, it should be shown that abnormalities occurred in that succeeding vehicle, 
and at this time, simultaneously, please become epidemic on "succeeding vehicle O watch, and 
stop by the loudspeaker 81 at it. Please stop. Warning with sounds, such as ", is made. 
[0128]It is shown that an applicable succeeding vehicle does not exist from the first in the case 
of a gray color. 

[0129]The digital readout (the example of drawing 19 55, 76) in () of O seal bottom classified by 
color shows the battery remaining capacity (the digital readout of full charge capacity is set to 
"100".) of the succeeding vehicle (the example of drawing 19 succeeding vehicles 1 and 2) in a 
percentage display. 

[0130]In the example of a screen display of drawing 19, although only the position of the leading 
car 101 is drawn on the map, it is also possible to display simultaneously the position of the 
succeeding vehicles 1, 2, 3, and 4 on this map with which the leading car 101 is drawn. 
[0131]Based on the received state information, at Step S7, the leading car 101, When it judges 
whether the succeeding vehicle follows by the predetermined distance between two cars (step 
S9) and flattery delay etc. have occurred, it warns of the speed fall mentioned above (Step S10), 
the fall of speed is demanded from a driver, and speed falls according to a driver's operation 
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m s ) niz&tb ustttfe ■ 7JCt«iE#a 1 2 2 ic«ig-r 

•5. 

[0 0 4 8] l>—*f\s—¥SOO>mtlfri±9tfiW.\Zft-t 

zmmt-fitiLvmrn • Tjfiffai^Ri 2 4ir j: yttas 

<X. Saife ■ 75(4»iE^S 1 2 2l-«|i&**l*. 
[0 0 4 9] Saife • 7J^iE¥Rl 2 2 fi. Jtfr*<D 

DisiiT-^. ffis-r*ta. mm&B: (x. y) i:7j(a 

9. 5fef7micJ4-r*ffi»i:75fi©fha«fitl~S-3#. IS 

[O O 5 O] ^atttB^ai 1 0<D&t)k* S^ife • 
7i<4^iE#ai 2 2©tt*J-efc-5&IE&a>S«ig>l:;»-3 
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74-F?*r?—l : mmmifimK2tl+ mX^Stl 26 

[0051] g*g&a- ia*ttai]mu i tott* 

[0 0 5 2] jBJt^fai 2 611 tom&m<DY<?-t*)lsffl 
iiSii^SlffllE C U 4 2 S^LT^-^ 4 41C«*& 
tio tolfSl 2 6li. ;tamSS0>:?U— 
ffPStSMBJlfclSPE C U84$^ LT^U— ^7^5^ 

8 6|3«*&-T^ 0 iDgfSl2 6lt *«bfC. JP 

8 8 S^LT^fT'JV^T^faX-^ 9 O izm^T 

ho 

[00 53]^8$102, 1 O 3fZfcM*£tfcHa)»& 

/<^^U4o<o^sa^S«ltti^S:i 2 8ic«fcy 
«i±l^*v. EB- ;*<ift3l¥jai 2 4-ettS[*tL/--5fetT 

*fco>*mni&fc«tcaa*iK (53. 92) 

T5fe»*l O 1 lc2Hl£;K* 0 

[0 0 5 4] SS^difSl 2 0lzj:y«|tll* 

2 2-ctts:**ifcg«*s^ < i:-r^5fef7*a)^s-r*La 

(5 3. 92) $1CT»«9 [«x(i. a 

[0055] @7li, &Mj£?7\zts\-tZ>9tmmi o 1 0 
^frECU60 (@5#ra) <numz&t>hz?n— 

[005 61 08. 9 I*. JS^J^lCfclf^^gim 1 0 
2. 103(Dtfi[ECU60 (@6#fiB) a)$qfB]|Z'&;b 

[0 0 5 7] KIT, ^tlt>0)Z?n—^-\r— h^ttlL 
£*<*K£ , ^B$lzfcMt35fc»*1 O 1 (D$«&paf£j3£ 

tf&sssi 02 (1 03) (Dfflm&ftiz-o^x&m-f 

ho 

[0058] *-*\ K^Jj£^o>iai&^rciai^<bffiS$ *r 
5 (x^^^s 1 . s 2 1) o «DaB^5anrii. iDt 

LT0Kf«I##A<*S$*iK5iJ#^fiS1g^i 1 6lzE 
l»^J#^0)*i6f>ttfcSliimS[1 0 
(ZC-ei*. *i$10 1«!:taSl02, 103-cfc 

y. j*tf. Siasi 01. 102. 1 0 3<t*a*5o ) <o 

[0059] b 1 o\tmm<D&iih?3$*LTi*z>o mm 
<t&mxit+ 3tmM ioi. &mm 102. 103 

m^P!3TS5ij*ti^o tH^txcommi 01. 

1 0 2. 1 0 3(7)M'DfiS-C. &&M0>&8S*1 03 CD 



£SG3 (X. Y, 0) >!)<. G3 (0. O. 0) t £ 
*U 0 2<9f8G2 (X. Y. 0) ^G2 

(4, 0. 0) <t£*l. ^i$10 1(Dl8G1 (X. 
Y, 0) A<G 1 (8, 0, O) tZtl&o titi-d 
I*. &\3W<Dftmt2*l. LfctfoT. fll^tf. 11 O 
CD{iS^«baiff*|SlA<Ytt^[pI^[pILxfc«^^li. 0 = 
9 O 4 tZtl&o 

[0060] MMi-cit upoioi* 10 

2. 10 3fl)W, 5fe3Sl 0 1 <Oftm\Zi)*y 

*u ^ants*** zo&mnmmxi*. %mmi 01 

CD^SOf*. GPS/DGPS Kfigl 7 O I: 

[0061] Sbiz, tnmtmmxit. $hok 1 
02. 1 0 3<Dt&mi£®}£Ltkmmi)<?Tt)ti. &&&&& 
^izm-^i^x^^T y >^-tr 8 o««a-ts >-9-<d« 

8§^t8»i0 2, 1 o 3^85t#mi o 1 

[0062] 5fc#$101lt COtt®««^SltT. 
&S*1 0 2. 1 0 3(Dtt®A<jE«-efc^^^5^JS 
L. JES-Cfc^li^icii. S4lzS*Mfz^-rj:5lc. 

0 1 (CtS^LfzilK#^. Xf7'J^W- 

;u^ss^ur5fe3imi o 1 tarcu ^fr£f§§fcrr& 

ttLfcfcfc-SBMWl::* 5fe#^101(i. GPS/D 

GPs*!<agg7oic£y*#fcem<7){as. -r^^^ 
$ucD&a cisg. mm) 1 eicam-r 

ztucj: y-trv*— 1 6 1*. «9J^fT+(D^ja)iS 

(b) ^o>f\mtifm£iEmzm&'?z>^ttfxz% 0 # 

fc. -a>Ht6o?^izfct>r. gps/dgps^8 

i7 0A>bfbil^Hfif-^li, 1 m§S 

XfohOX. \tmb\z^&tttfftt>Hi)T)\,*4J±\Z 
ftmZtlhj&fe&ft (mz-l£. Kj$4 0kmrimF B lP| 

[00 6 3] ca)<t5icLT. jsimicii. 9t^mzn 
Lx&mm&-^mmm%k im) & 

10 2. 1 O 3 jf><. 1 O 1 CD®im& ilf» ( h 

1 o 1 (DSSifeSSfib^© 9 O . Ett-tr >it 7 2 t 

(ittr^rai) ^^fS^raS. -M^li. 1 Omsgicgf 
0>gi£i&&gG1 (X. Y. 0) i:LT^as-r^ 

[00 6 4] ^aL/c^mfis • -?jfafrt>*3iz>m&*&m. 

mo 1 i&fM&Y KUX£ L. I@G 1 CD^^<t Lt(D 
StlSI^T-^ l^Sfia (X, Y) tjjftd) irLTlBffi 
^S9 3IZlBtg-r^ (Xf7^S4) o 
[OO 6 5] ttff>tttt¥«9 4tt % S«G1t7)«l£lS^ 
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^f7 'J >^*tr 8 0 0>#tfM*« (T^-feiU0>iafil^ 

*tJC-r^^-^4 4a)gf^fi-efe^««fflih;i.^T (n 

m) % :7U— *&E2)P (N/m2 ) ^l/^f7'J> 
^<7>&Soj (d e g) } £&diL. tittS (T. P. 

5) o ^<d£5\zlt. iats*a9 3izii. ^icswa-r 

[00661 91111 5fca*3M O 1 a)^ft««[^-^ 
;H 3 2<D«j£ffl£7FL-Cl^o Kt6^®9 3l*. Z(D 

mficDj&sg-ei*. 3 ooo<i<&u>^/^;77cfcy«j5Jt 

(X, Y. d) = (XI. Y1, 01) <tIElt£*l. si 

(T (Nm) , P (N/m2 ) , W (deg) I = (T 
1. PI. £0 1) <tfBtt£*l,£o 3feff1**T— 3 
2l:7K^No. 3 0 0 0 ^TttlS^— £ <t itflf 

-stfiBtfi**!/--*^. t kuxn o. iicsffc^ttai 

[0 0 6 7] IIBLt. K^J^I^fclf^^©!® 

(X. Y. d) + . fie«l»x-^ (X. Y) li. tK- 
hl 3 (A) &&<DV}mititLm$:l£&tL. /-K-H3 

(b) ifi^oxia^ii^fia^-r^^ax-^^fc^o 

10msS, B^Sflta. t btOffiSI 

2 0)tB^$. «;U£ffi»Ra. Rb, ^<&1z > 
-9-7 4(0***. fl^CWSfSlG a. dhkLtzmS\Z^ 
mU t aTttglS^-* (X. Y. 0) £. 

(X. Y, 6) — (RaX C os0a. R a x s i n 6 
a. 0 a) k-fZkZ^ B$Mt b-ecDSJlSl^r— * (X. 
Y. 0) I*. SlSH 5 -* (X. Y. 0) = [R a x c o 
s 6 a -h (Rb-Ra) c o s 0 b . RaXs i n 0 a 
+ (Rb-Ra) s i n9b, 0 b) £tHC**L& 0 

[0 0 6 8] 0 1 C7)ES^S9 3lCE1fi*tvfc 

sfrtBa^-^ 1 3 2 1*. 5t*m 1 o i (D^Kmt 

LT. 5fc»mi o KD«tt»«?a (flixii. «<]ffiih;i,**> 
7 Is— &E*>X f7 »J > ^ffifc rt^SEH* £ £ o T 
t^4^C0««i) <b<t*,lc, 0 2, 1 0 3lC^f 

6) o 

[00691 -S, *$a$1 02, 1 03t, 
^ai^Sl 2 0lcj:y 1 OmsSlcffiSKz:^^ 2 £^ 
tt^>th7 4<Bfcii;*jfr£>gStea (X. Y) 
&fciiL. @7fLTI^I*3 O O 0<lC7>y >?/<vZ?7fr 



«bfc£IBtg^ia9 3lC|Hlg-r^ (^f'^S2 2) o 
[0 0 7 0] *ft8iai 0 2. 1 0 3 1*. 

^3fS6-Cffc3imi 0 1*&a«S*lfcSfc»»1 0 1<D 

*ffi«ifcap»flMBt««*a (53. 92) ic*y» 
<f-ra (xf-^s2 3) 0 

[0071] *ivc % &&mm 102. 1 O 3 ii. 

!±. 5fefT»li*»*1 0 1 -Cfcy. &f£i|U 0 3<7)igt£ 
fzli. ffefrmii^ami 02tfc5. ) *-C(7)SK^^ 

a <u-^«$8) *u-ifu-^5ofccfct;ffi»-^ii 
tfa^ai 24ic^yti-ffl-r* Uf7?s24) . 

[oo72]*i:, S$g»i02, I0 3(i. y 
1 0 1^(D«i»t3b>f,S*<D^*^*fi 
Uf^S25) „ ca>*T»??S 
2 5(DfiIJSL<^no 
[0073] §iSa>j£mfiBM*. ffi*t-fe> 

i^72 (ma-b>ito)a^fii-e4,^^p ) fc*tM*;£<a 
t>^7 4 (a — h-t?>-9-c7>«^fiir^cfciv ) <o 
di*aiaffi-e**y. ^j^«a>«^^tt<fe»(DjtfT»i 

J:5^T^-b;U. :7U— ^r. Xf7'J>^*$ll»t*ilf 
J:L^5i:txbWo LA^L. H(g±. fct^.. [sJ— 

ma-efcor%. K@«3E0)atv jfitt^if^ 
[oo7 4] zc-e. 

G B : tttt«<0S«IR 

X F ( t 1 ) : ^SO t 1 r*Ct>*frm(DXffiS («xtf. 
11 1 fC^Lfc^ffttia^-^UI 3 2JKD«l»7 ; -^ 
No. 1 X 1 ) 

YF (ti) : t 1 -CtDSfcfracDYffiS 

©18^-? — ^ No. 1 TI*. Y 1 ) 

6 F ( t 1 ) : B#£0 t 1 -CCT)5fe^ac7)a-ftJS (fcl* 

i£. SliS^T r — £ n o . i -ci*;5rsi0 i) 

xB(tD : nsnt i xo^mmcoxmm 

Y B ( t 1 ) : ^Sl t 1 -CCt>f*fii«0)Yffi« 
0B(t1) : tifM t 1 -CCD^amcDa— ftg 
JaT. SI 2j#iLTSf^t^o 
f B : &S!»m'&{£SG 2 3b>t>U-+fU— ^5 0C7>IXft 

b f : ftfrmmfoGLWiG i a^u-yn-ajSTfe^y ^ 
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mm (i«f*ii) 

A 6 FB : GBiS»b^:G Fft«^<D[E]&ft (ft 

±ffi(Zm-*l<O5£S<0 SSftliAXFB, AY 

[0075] B$g]t 1-e0)U-^tta^ (»J?U>>*5 
2) jGFSSlTf$Lf:SS [X' F (t 1) , Y* 

F(tD)tt % *o(D«, (2) ^-ca*n-5o 

[0 0 7 6] 



5 2^T0)^)!t 
Lx (t1) : ftM t 1 -CCOU— +f U— 5^5 Oir'J ? U 

5 2rBlffi»0)iifT*lSl^ (U-*«?8) 
Ly (t1) : m&lt tfU— ?50t>j7b 

5 2raffiao)itf7^fsiicaft?5:*e^isja)fiE^ cu 

-^1S*) 

AXFB: GBftS^^b^/cGFftS^^CD&gX 

fta (fts-rtis) 

AYFB: GBftS^t)^yrGFftg^lS^<DaaY 

X' F (tl) =XF (tl) -bFx C os0F (tl) — ( 1 ) 

Y' F (tl) =YF (t1) -bFXsin0F (t1) — (2) 

&fMt ^v<Dis—¥ftm&$:GBmm3!k-c&Ltzmm o) -a. (4) af$^§ 9 

[X' FB (t 1) , Y' FB (t 1) J [0077] 

X' FB (tl) =XB (t1) + {LX (tl) + f B} 
1) + LY (tl) x s i n 0B (tl) 
Y' FB (tl) = YB (t1) - {LX (tl) + f B) 

1) +LY (t 1) x co a OB (t 1) 

mmzftfrm&ftm t i <D&sfr*&fM t 2<D&a:\z& thztiz> 0 
mLtz±£<Dmmt,mm\zxo> (5) it- (8) 5t-e$r [007 s] 

X' F (t2) =XF (t2) -bFxcosOF (t2) 
Y' F (t2) =YF (t2) -bFXsin0F (t2) 
X' FB (t2) =XB (t2) + {LX (t2) + fB) 

2) +LY (t 2) x s i n 0B ( t 2) 
Y' FB (t2) =YB (t2) - {LX (t2) + fB) 

2) +LY (t2) Xcos^B (t2) 
Ztlh>2-0<DmMt 1 . t 2-(?<D4ia { (1 ) 5t 
t (2) (3) SZt (4) 5*. (5) j£t (6) 

a. (7) &t (8) 5*} <d^-£ & z>m&%ko)?tim 

(AXFB. AYFB. A0FB) 
[0 0 7 9] *-T. GFSgI±-C0)«g^ {X' F 

0' F ( t 1 , t 2) =a r c t a 



x c o s 6 B ( t 

- (3) 
x s i n 6 B ( t 
... (4) 



— (5) 
(6) 

x c o s 6 B ( t 

- (7) 
X s i n 0 B ( t 

(8) 

(t 1) , Y' F (t 1) } tm9A IX' F (t 

2), y* f (t 2) i tmsmmt* xFiottfl 

£0' F (t 1, t 2) 3*U*. (9) 

[OO 8 0] 

[ {X' F (t 2) -X' F (t 1) } 



/(V F (t2) -Y' F (t 1) } ] .» (9) 

■«fZ % G Bftffl£JbT?a>ft«J& {X' FB ( t 1 ) . B ( t 1 . t 2) ^-T^-t. C*lf*. X0> (1 0) xtT* 

Y' FB (t 1) J «tft«jS {X' FB (t 2) . Y' *U**l4. 

fb (t2) } &mJBMMt+ xB$&<D%:-?nze' f [oosn 

0 ' FB (tl, t2) =arctan [(X' FB (t2) -X' 
D)/(Y' FB(t2)-Y' FB(t1)|] 



FB (t 
(10) 



w (n) ^-e*ttt>4x^ 0 

[0 0 8 2] 



A0FB=0'FB(t1, t 2) — 0 ' F (t 1, t 2) 



^S^O)X^[SjCOftS*rtiaAX FB£ % Y*fS]0)ftg| 
-fttSAYFBIi. BSSflt 2lCfcJt^)«ffl^t»^(0 (1 

AXFB = X' FB ( t 2) -X' 
2) x s i n A 0 F B 

A Y FB= Y' FB ( t 2) +X' 
2) x C osA0FB 

fCT\ ISfHi (AXFB, AYFB. A 0 F B) 



(11) 



2) a. (i 3) ic-c»ai*tt^o 

[0 0 8 3] 
(t2) x C osA0FB-Y' F (t 

— ( 1 2) 

(t 2) x s i n A0 FB-Y' F ( t 

- (1 3) 

<j>&&mm%v\'mmm m oms> ic*4l-c*o< y-e 

Oms§lzS:aiL-Cl^o 
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[0 0 8 4] Z<DJ:5l::«mLfcffiS-rft«£EL^-ce 

it *(D(i4)i-d6) 5£-e«&-r<5 -£*<-e£ 

XFB (t) =AXFB+XF (t 
A 0 FB 

YFB (t) =AYFB-XF (t 
A 0 F B 

0 FB (t) = A0 FB+0 F ( t 

air. ftftmwim\z&t)-&z>£5\^£Wi&w£&iE-rz> 

XBS (t) =XB (t) Xcos 
A 0 F B) — A X F B 

YBS (t) =XB (t) Xsin 
A 0 FB) -AY FB 

0BS (t ) =0B (t) -A0F 

tz#>\z9tmm ioisi nm. &mm i o 2 $2f$, 

03j3f$ < tl>5Ci:i:t5 0 
[OO 8 7] mil". 2-^SfZ1^*G1ffi 

&^<D»i8Mflfa {XI (t). Y1 (t). 01 
(t) } 6<3lt>tU^ 0 JUll*. ^P-K^** h£*t* 

[00 s si m2ic 2^*i4g«Lfc«i»«« ui 
(t) . y 1 (t) . 0 1 ( t) i smx-ftm^tz 

G 2ffiS^«lSM»a (X2(t), Y2(t), 02 
(t) } t % 2Wb1§?ffH!Lf:U-^«i: 

A>t>G2ffia^<tG 1 sa^(D&a-r*t* cax 1 2. 

AY 12, A 0 1 2) ^SSfflL. S*fifi*«jE-r*o 

[0089] m3iz. z^mitG2mmm«i»-c(omm 

t£M (X2 (t). Y2 (t), 02 (t)} <t . G2 

mmmtG i m&jk<Dm$Hr*im (AX12, ayi 

A X 1 3=AX23+AX1 2x c 

AYI 3=AY23-AX1 2x s 

A0 1 3 = A0 2 3+A0 1 2 

§?l»flfi (X1 ( t ) . Y1 (t), 01 (t)} 
i G 3l«^b^fcG 1 18S(Dl8f *li ( A X 1 
3, AY 13. A 0 1 3) ftt&jEatt1-3*tM*£J(tiS 

[0095] ZKDcfcodLT. Xt^^S 2 5lCfcl*£ 
#&f&S10 2. 1 O3lCfcl*&Si£ife<fc;frtt<0teiEffi 

[ O O 9 6 ] #13. &f£S 1 0 2. 1 03I1 Uib Ltc 



4o 
[0 0 8 5] 

) x C osA0FB+YF (t) xsin 

— (1 4) 

) xs i n A0 FB+YF (t) x C os 

— (1 5) 

) »• (1 6) 

7) it- (19) sc-e«as-r*ci:3&<"c#*. 

[0 0 8 6] 
(-A0FB) -YB (t) xsin (- 

— (1 7) 

(— A 0 F B) + YB (t) Xcos (- 

— (1 8) 

B — ( 1 9) 

2. A012) £3-^mi^LT£{rr*o 

[0090] 3*«l»«Lfe2**0)|U»1» 
«(X2 (t), Y2(t). 0 2 (t) } <t. 
ttXLfcG3&aXa>IMMttt (X3 (t), Y3 

(t) . 0 3 (t) J 3«**&2««£ttaiLfe 

u- y nm <t * g 3 ass** <t g 2 &*g&<D&e-r*LS: 

(AX23, AY23, A0 23) ^Stiit"^o 
[OO 9 1] ®5|CG 2&m^tG 1 ffiS^«htf)ffi&-r 
tli (AX12. AY12. A0 1 2) <t. G3£81 
^G2ffia^t<DffiS-r4xa (AX2 3, AY23, A 

023) ^^ibG3ffis^t>^fcG 1 jsa^o^a-r 

*ia (AX 1 3. AY13, A013) ^%^i>o 

[00 9 2] ii 4i*. z<D&a\<D&mt£ti%m®-e 
fey. G3Sgs^b^G 1 &S2sa>ffi«-r*ia ca 

X13, AY13. A 0 1 3) f*. (2 0) 5t~ 

(2 2) 3£(0cfc5l::»fcii£4x&o 
[0 0 9 3] 

osA012+AY1 2x s i nA012 

— (20) 

i nA012 + AY1 2X C osA012 

— (2 1) 

— (22) 

^<^*i*i o 1 0gftij7-f-K7t9- KffM 

;H*^ai 1 2i=*y»u-r* Ufy?s2 6) . 
[0097] hi 5 1*. »ftaaanBao>pjBju— ^> 

[0 0 9 8] 13 1 61*. 0 2 <D« jES«Jfe. 

*l£. ±2U: (1 7) 5£<BXBS (t) £X. (1 

8) 5£(0YBS (t) *YfcLfc¥BattftEB**Lr 

-ttzt>*>. &8SS1 0 2li. (X, Y) IC# 

1 0 1 ©*frl«Hc«te«j6fTtll*T— ^ 132JS 

aMlCHPLfctO-Cfcy. tttt^-* (Xn-1. Y 
n-1). (Xn. Yn). (Xn + 1. Y n + 1 ) |C 
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^Jl^tlttJSLTjgfEST— 2 (Tn-1, Pn-1. 
COn— 1) , (Tn. Pn, (D n ) , (Tn + 1, Pn 
+ 1 . 60 n + 1 ) tftflBLTl** (H 1 1 £#&) D 

[0099] *c-e, &mmi 02^ tsfta 

LT0lB> (Xn, Yn) l:Mit^gf^if- 
* (Tn. Pn. OJn) £JBL>T jftff It £ & 
jESSea (X. Y) £5fc»*1 O 1 C7>#l8«ig (Xn 
-1. Yn-1) , (Xn. Yn) , (Xn+1. Yn 

Ln-1= { (Xn-1-X) 2 + 
L n = { (X n -X) 2 + (Y 
|_n + 1= { (Xn + 1-X) 2 + 

*az % (2 6) 5tic«rwa«t*-r* (x-r*^s 

2 6 b) o 

(Ln + 1+Ln) < (Ln+Ln 
ZC9 (2 6) a\Zir.ttm&tff£±LLXl^fri:5fr£ 
ffiEL, JftALfcUft. -Tttfct. «©ElLn + 1tf 
-ollOBiLn-1 *iJS<4ofcitl:tt, ^00) 
gf^S K7*"7— K*W«a»*«1 1 2ICJ: 

y»**ft*?-r— K:?*?— K*M«> ^lttHS& 

© (Xn + 1, Yn+1) |Z&lt«n + 1 SSCOt"— $ 
"tr*y h"Cfc-5Srfc^CSf^S (Tn + 1, Pn + 1, con 
+ 1) £Sffl-r<5 Uf'^S2 6c) . 
[Ol 02] Z<Dt^\Z\t. «tfr£Sn£n + 1(ZlESr 

(XflSl^S 2 6 d) o 
[0 10 3] (2 6) SC0^?3£a<j£:&LTU£: 

-0«f<OMLn-1 *<*<0ffi«L 

n + iA<j:ys^»*ictt. ^nKoa^a 

KW8PM) *«ttttfflLTi**tt8MMB (Xn. 
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